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INTRODUCTION 

This document describes the design of an ac motor con- 
trol system using the ADSP-2115 digital signal proces- 
sor (DSP) and the ADMC200 motion coprocessor. The 
architecture illustrated in this application note can be 
utilized for a number of systems, and was chosen for 
illustration purposes only. The purpose of the document 
is to demonstrate the use of the ADMC200 in the digital 
implementation of a high speed motor control system. 

The document starts with a system hardware descrip- 
tion that illustrates the hardware simplification when us- 
ing the ADMC200 and ADSP-2115. A typical control 
scheme is described to demonstrate the ADMC200 fea- 
tures. A control algorithm is produced to match the de- 
scribed control scheme. The DSP control software is 
presented in both pseudo code and in DSP assembly 
code. This code demonstrates how the ADMC200 func- 
tions can be closely integrated into the control algo- 
rithm. Timing information is also presented which 
shows how the shaft torque functions could be imple- 
mented in less than 20 us. 

SYSTEM HARDWARE 

The complete system consists of a permanent magnet 
ac servo motor with a shaft mounted resolver, a three 
phase power inverter, and the motor control circuit. The 
primary ICs in the control circuit are the ADSP-2115, the 
ADMC200, and the AD2S90 resolver-to-digital converter 
(RDC).The DSP is the shaft control processor and carries 
out all the motion control and torque current loop func- 
tions. The ADMC200 is the interface between the DSP 
and the inverter, and in addition provides the vector 



transformation functions required for ac motor control. 
The interface to the host controller can be either via the 
DSP data and address bus or via the serial port. 

The motion control software is stored on an external 
8-bit EPROM and is automatically loaded into the DSP's 
IK words of internal program RAM on power-up. Each 
of the 24-bit program words is stored on the EPROM in a 
4-byte segment. The DSP boot firmware copies the pro- 
gram from the EPROM to the internal RAM in the correct 
order to rebuild the 24-bit wide program memory. This 
arrangement limits the external EPROM requirement to 
just a single slow memory device. 

It is possible to switch between eight pages of program 
memory RAM stored in a 32K EPROM . For example, the 
first boot page could contain the programs which will 
initialize all data variables (look up tables, etc.), config- 
ure the ADMC200 registers (setup PWM registers, etc.), 
and perform self-diagnostic functions. While the second 
page can contain the motion control algorithms which 
are loaded at the end of the initialization phase. 

The ADMC200 device can be connected directly to the 
DSP data and address busses, as described in detail in 
Appendix C. The internal registers can be written to in 
the same way as data RAM placed in the low memory 
address space. The shaft control algorithm can be timed 
through the ADMC200 CONVST pin or via the interrupt 
pin on the DSP. 
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Figure 1. Motion Control Hardware 



THE CONTROL SYSTEM 

Figure 2 below illustrates a field oriented control 
scheme for a permanent magnet synchronous motor. 
The outer position and velocity loop calculates the 
torque demand which is the input l q * reference for the 
current loops. At speeds less than the base speed, the l d * 
reference current will be zero. If an extended constant 
power speed range is required, the field control scheme 
can introduce some field weakening by setting a nega- 
tive l d * value as a function of the motor speed. 
♦Reference input to controller. 



The analog-to-digital converter (ADC) block within the 
ADMC200 samples the motor currents; the vector trans- 
formation block performs a reverse Clarke and Park vec- 
tor transformation on these ac current waveforms, 
mapping them into equivalent direct and quadrature 
current components within a rotating reference frame (l d 
l q ). A current loop control algorithm implemented on the 
DSP calculates desired V d and V q voltages for the motor. 
Finally the ADMC200 forward vector transformation 
block performs a forward Park and Clarke transforma- 
tion, mapping these direct and quadrature motor volt- 
ages into ac voltages within the stator reference frame. 
The DSP scales and then write these results to the PWM 
block of theADMC200. 
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Figure 2. Motion Control System 
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CONTROL ALGORITHM 

An outline of the control algorithm, based on the 
scheme in Figure 2, is given in Table I. The functions in 
bold are implemented on the ADMC200 coprocessor. 
The scheduling of the control algorithm is synchronized 
with the ADC interrupt service routine. In this applica- 
tion the ADC will generate an interrupt at a rate of 
10 kHz. The torque control loop is realized at this fre- 
quency, while the motion loop is scheduled every fourth 



ADC sample. The motion control loop can be segregated 
into a posterior and a priori measurement portions. The 
a priori portion is executed during the first three time 
slices while the posfer/'orportion is executed in the forth 
interval. The basic torque loop functions can be carried 
out in less than 20 lis; this leaves the remaining 80% of 
the time for the motion control loop and other functions. 
The code required takes up less than 10% of the avail- 
able IK of internal program RAM . 



Table I. Control Algorithm Outline 
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TORQUE_LOOP FUNCTIONS 

A more detailed explanation of the torque control loop 
is given in Table II. In this example the ADC sample rate 
is tied to the PWM frequency by connecting the 
PWMSYNC pin to the CONVST pin. All four channels are 
converted in sequence, and the completion of the con- 
version process will be signaled by an interrupt to the 
DSP, which initiates the Torquejoop. The control inputs 
to this loop are the reference currents l d * (ld_ref) , l q * 
(lq_ref) derived from the motion control loops. The mea- 
sured inputs are two motor phase currents (l B , U and 
the shaft angle p (rho). The outputs are six deadtime 
compensated PWM signals for the inverter. 

Only two current values are measured by the ADC since 
the third phase is derived by the ADMC200 vector trans- 
formation block. The reverse vector transformation pro- 
duces Id and lq currents in the rotor reference frame. 
The reverse Clarke and Park vector transformation block 
executes in 37 clock cycles; the block interrupts the pro- 
cessor on completion. While the vector rotation has 
been performed, the computation resources of the DSP 
are thus free to perform other tasks such as overcurrent 
detection or velocity signal conditioning. The current 
loops are based on a machine back emf model with a PI 
error loop, as outlined in Appendix B. 



The winding resistance drops (IRq = l q *.R s tator) are 
precalculated by the motion control loop. The current 
loop outputs, the Vd and Vq voltages, are fed to the 
PARK block. When the shaft angle is loaded into the for- 
ward angle register (RHOP), the forward PARK transfor- 
mation produces the three motor phase voltages. 

The phase voltages can be scaled as a function of the 
bus voltage and the PWM period. Deadtime compensa- 
tion is implemented by adding/subtracting the deadtime 
to/from the PWM zero offset time depending on the 
phase current polarity. The DSP writes the three PWM 
on time duty cycles to the PWM input register. The PWM 
output registers are latched with the new duty cycle in- 
formation at the beginning of the next PWM period. The 
updated PWM duty cycle data is only latched if all three 
of the input registers have been updated. 

Sample code for some of these functions is given in 
Appendix A. Two sets of circular arrays are used for the 
phase currents and phase voltages. The ADMC200 regis- 
ters are memory mapped to the data memory address 
bus and so are read as data variables. The wait states for 
the ADMC200 access are defined in the ADSP-2115 data 
memory wait state control register. The use of indirect 
addressing in the PWM_scale routine allows the use of 
the simultaneous multiply and memory read function. 
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Table II. Torque Loop Algorithm 



Start_torque_loop 


wait for ADC interrupt 


elapsed 
time 


Read_ currents: 


ADC int: 

read lph(2) from ADMC200: ADCV 
read lph(3) from ADMC200: ADCW 


1.1 US 


load PARK registers 
for stator to rotor 
transformation 


write lph(2) to ADMC200: PHIP2 
write lph(3) to ADMC200: PHIP3 
write p to ADMC200: RHO 




Clarke Park: 1 


meanwhile check for over current 
wait for RPARK interrupt 


5.1 [is 


read PARK registers 


RPARK int: 

read Id from ADM C200: ID 
read Iq from ADMC200: IQ 
read lph(l) from ADMC200: IX 


5.9 (j.s 


l_control_d 

error driven PI loop 

(save DVq_n and Dlq_n 

values) 

-knachine equations 


Did nl =ld ref - Id 

DVd nl=DVd n+KPd*(Dld nl-Kld*Dld n) 
DVd n =DVd nl 
Did n =Dld nl 

Vd=DVd nl +(L s .l q )*velocity 
+ [IRd=! d *.R s ] 


7.8 [is 


l_control_q: 

error driven PI loop 

(save DVq_n and Dlq_n 

values) 

-fmachine equations 


Dlq nl =lq ref - Iq 

DVq nl=DVq n +KPq*(Dlq nl-Klq*Dlq n) 
DVq_n =DVq_nl 
Dlq n =Dlq nl 

Vq = DVq nH-(K E -H_ s .l d )*velocity 
+ [IRq=! q *.R s ] 


9.6 [is 


load PARK registers 
for rotor to stator 
transformation 


write Vq to ADMC200 VQ; 
write Vd to ADMC200: VD; 
write p to ADMC200: RHOP; 


9.9 [is 


Parte riarkp 1 


lYiAnniAihil^ Ho crnmp \/plnritv f i Ifpri nn 

1 1 ICQI IVV 1 IMC UU JUI 1 IC VCIULI Ly 1 1 1 LCI Illy 

wait for FPARK interrupt 


13.9 [is 


read PARK registers 


FPARK int: 

read Vph(l) from ADMC200: PHV1 
read Vph(2) from ADMC200: PHV2 
read Vph(3) from ADM C200: PHV3 


14.8 ^s 


PWM out 

deadtime adjustment 
reverse for -ve Iph 
calculate PWM times 
write to registers 


fori =1,3 

TO =TPWM/2 +TPD 

IF lph(l) LT TO =TPWM/2 - TPD 

T(l) =T0 +VSCALE*Vph(l) 

write T(l) to PWMCH(I)_ADMC200 

end_for_loop 


18.0 [is 
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APPENDIX A: ASSEMBLY CODE SEGMENT FOR TORQUE LOOP 



Read_ currents: 

Read ADC registers 
and write to PARK input 
registers 



RPARK starts: 
Clarke Park" 1 



Read PARK output 
registers including 
derived third phase 
current value. 

set up pointers for 
current loop call 



FPARK starts: 
Park Clarke -1 



ADCJnt: 
i3=~l_ph; 
ml=l; 
13=3; 

axO=dm(ADCV); 

dm(i3,ml)=ax0; 

dm(PHIPl_VD)=axO; 

axl=dm(ADCW); 

dm(i3,ml)=axl; 

dm(PHIP2_VQ)=axl; 

ayO=dm(theta) 

dm(RHO)=ayO 

i7=^error_int 

call over_current 

i7=^RPARK_int; 

rti: 

RPARKJnt: 

ayO=dm(IX_PHV3); 

dm(i3,ml)=ay0; 

iO=^ds; 

10=2; 

ayO=dm(ID_PHVl); 

dm(i0,ml)=ay0; 

ax0=dm(IQ_PHV2); 

dm(i0,ml)=ay0; 

i4=^ld_ref; 

m4=l; 

14=0; 

i]=~Dld_n 
11=2; 

call l_control 

dm(PHIPl_VD)=mrl; 

il=T>lq_n; 

i4=^lq_ref; 

modify(iO,ml); 

call l_control 

dm(PHIP2_VQ)=mrl; 

dm(RHOP)=ax0; 

i7=^error_int; 

call ADC_fi Iters; 

i7=TPARK_int; 

rti; 



■{pointers for l_ph CIRC array} 



{Read lph(2) from ADCV_ADMC200} 

{write lph(2) to PHIP1_ADMC200} 
{Read lph(3) from ADCW_ADMC200} 



{write theta to RHO_ADMC200:} 
£tart RPARK by writing to ADMC200} 
{error if next call takes >37 cycles } 
{check for over current during PARK} 
{interrupt vector set to RPARK } 



{Read lph(l) from ADCW_ADMC200} 
{pointer for Id and lq} 
{Read Ids from ID_ADMC200} 
{Read Iqsfrom IQ_ADMC200} 



{current loop for Id return Vd in mrl} 
{write Vd to VD_ADMC200} 



{j0 now points to lq} 
{current loop for lq return Vq in mrl} 

{write Vq to VQ_ADMC200}ax0=dm(theta) 
{write theta to RHO_ADMC200: start FPARK} 
{error interrupt vector for >37 cycles} 

{store vector for park interrupt} 





FPARK int: 




set up pointers 


i2=^V ph; 


{pointers for V_ph} 


for Vph 


m2=l; 






12=3; 




Read PARK output 


axO=dm(PHVl_VD); 


{Read Va from PHV1_ADMC200} 


registers 


dm(i3,m3)=ax0; 






ax0=dm(PHV2_VQ); 


{Read Vb from PHV2_ADMC200} 



-6- 





dm(i3,m3)=ax0; 






axO=dm(PHV3); 


{Read Vc from PHV3_ADMC200} 




dm(i3,m3)=ax0; 






il=-pWMTCHA; 


{pointers for pwmtcha_ADMC200} 




ml=l; 




PWM_out 


11=1; 






ayl=pwmtdt; 


{dead time compensation} 


including: 


axl=pwmtm_0; 


{pwmtm/2} 


deadtime adjustment 


myO=dm(pwm_sc); 


■jpwm scale factor} 




mrO=0; 






cntr=3; 






do pwmout until ce ; 






ar=axl4ayl, ax0=dm(i3,m3); {to incl +tdt adjust} 




af=pass axO; 


{check current polarity} 




if It ar =axl-ayl; 


-Of -i then -tdt adjust} 




mrl=ar; 


load adjusted tO} 




mx0=dm(i2,m2); 


V_ph} 




mr=mr-HnxO*myO(ss); 




£on^0-K4/-tdt)4v_ph*(t0/vbus) } 




pwmout: 






dm(il,ml)=mrl; 


{write to pwmtchx_ADMC200 } 




call motion_control {run position and velocity in remaining time} 




rti; 





current_loop(13 ops) 


{ 




PI error driven loop. 


af =Dlq_nl =lq_ref - Iq 






mr =int = Dlq_n * Klq 






ar =sum =Diq_nl +int 






mr =DVq_nl =DVq_n+(sum)*KPq 


PI part 




ar =Vq sum =DVq nl+IRq 






mf =PHI =KEq-Hd*Ls 






mr =Vq =Vq sum + velocity*PHI 


machine equations 




} 

l_control: 






axO=dm(iO,ml), ay0=pm(i4,m4); 


{axO=!q ayO=lq_ref } 


Iq error 


af=ayO-axO, mxO=dm(il,ml), my0=pm(i4,m4); {mxO=Dlq_n, myO=Klq} 




mr=mxO*myO(ss), my0=pm(i4,m4); 


{mxO=KPq } 


integral part: 


ar =mrl-faf, mrl=dm(il,ml); 


{mrl=DVq_n} 


proportional part: 


mr=mr4ar*my0(ss), ay0=pm(i4,m4); 


{ayO=IRq} 


save old values: 


dm(il,ml)=af; 


{Diq_n =af} 


-Hnachine equations 


dm(il,ml)=mrl; 


{Dvq_n=mrl} 


add IR drop to Vq 


ar =mrl-fayO, mrl=pm(i4,m4); 


{mrl=Keq} 




mxO=dm(iO,ml), my0=pm(i4,m4); 


{mxO=ld,myO=Lsq} 


q axis flux 


mf=mr4mx0*my0(ss), mrl=ar; 




q back emf 


mxO=dm(velocity); 




total Vq 


mr=mr4mx0*mf(ss); 






rts; 
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APPENDIX B: CURRENT LOOP EQUATIONS 

The current loop equations are based on a PI driven 
error loop and the machine winding model. 

The machine equations for the U d and U q voltages are: 



U d =l d »R s +m r *(L s *l q ) 
U q = l q 'R 5 + <i> r *(L 5 *l q +K E ) 



Eq. (1) 



The PI loop is of the form: 

G PI (s) = K p »ll+?fj Eq. (2) 

The discrete from of thiscan beobtained by substituting 

This gives an equation of the form: 



Gpi(z) = KP> 



z-1 



where, KP =K P »\ |, Kl 



1+ 



Ki-T s 



Eq. (4) 



APPENDIX C: ADMC200 INTERFACE 
ADMC200 Address Decoding 

The ADMC200 address lines is connected directly to the 
lower four bits of the DSP address bus (AO to A3). The 
chip select line (CS) may decoded from the higher 
address lines. For example if CS is derived from A4 and 
A5 using a dual input NAND the ADMC200 is placed in 
the memory address space 0030 to 003F. The DSP data 
memory select pin (DMS) is connected to the chip select 
pin on the ADMC200. The DMS can be logically com- 
bined with some of the higher address lines if a number 
of devices are to reside on the bus. The 12-bit data lines 
should be connected to the lower 12 bits of the DSP data 
bus, thus scaling full scale positive output to +2 11 . The 
DSP DMRD is connected to the ADMC200 OE an is as- 



serted in read operations. The DSP DMWR line is con- 
nected WR line to enable write operations to the 
ADMC200. The read and write operations will take only 
one CPU clock cycle, so the appropriate memory wait 
state registers can be set to zero. 

The ADMC200 will produce an interrupt output on 
completion of an A/D conversion sequence or a PARK 
transformation. The interrupt output can be connected 
to the IRQ2 line of the DSP, so that the DSP reads the 
appropriate registers immediately on the completion of 
each ADM C200 function. The RST should be enabled via 
a system reset line, so that the ADMC200 is reset on a 
DSP reset. 



The difference equation for this transfer function is: 

DV K+1 = DV K + KP*DI K+1 + KP*KI*DI K Eq. (5) 

The applied V d and V q voltages are the sum of the calcu- 
lated machine winding voltages, Equation 1), and the er- 
ror correcting term from the PI loop Equation 5. 



V d =AV d +U d 
V q =AV q +U q 



